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INITIALIZATION (t=0, ETC.) 
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SOI 2 



WAIT FOR TIMER INTERRUPT (FOR EACH CONTROL aCLE). 
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IS GAIT 
CHANGING? 
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READ NEXT TIME GAIT SUPPORTING LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAIT SUPPORTING LEG COORDINATE SYSTEM, 
CURRENT nME GAIT QCLE, AND NEXT TIME GAIT QCLE. 



S020 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETER OF NORMAL GAIT 
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SUBROUTINE FOR DETERMINING INITIAL STATE 
(INITIAL DIVERGENCE COMPONENT, ETC)OF NORMAL GAIT 
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S026 



PROVISIONALLY DETERMINE GAIT PARAMETER OF CURRENT TIME GAIT 
INCLUDING DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT 



SUBROUTINE FOR CORRECHNG CURRENT TIME GAIT PARAMETER 
(CORRECT CURRENT TIME GAIT PARAMETER SUCH THAT DIVERGENCE 
COMPONENT AT END OF CURRENT TIME GAIT AGREES WITH INITIAL 
DIVERGENCE COMPONENT OF NORMAL TURNING GAIT.) 



S028 



DETERMINE PARAMETERS OF ZMP PERMISSIBLE RANGE AND FLOOR 
REAQION FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE 
FOR FULL-MODEL CORRECnON. 
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SUBROUTINE FOR DETERMINING CURRENT TIME GAIT INSTANTANEOUS VALUE 
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DETERMINE ARM SWINGING OPERATION TO CANCEL SPIN FORCE 
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DETERMINE INSTANTANEOUS VALUES OF ZMP PERMISSIBLE RANGE AND FLOOR REACTION 
FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE FOR FULL-MODEL CORRECTION. 
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FIG.12 



DETERMINE INITIAL STATES (STATES AT INITIAL TIME Ts) OF FOOT POSITION/POSTURE, BODY 
POSTURE ANGLE d bs, AND ARM POSTURES ON THE BASIS OF NORMAL TURNING GAIT PARAMETER. 



PROVISIONALLY DETERMINE INITIAL (ATTs) BODY HORIZONTAL POSITION, VELOCITY, 

ANGULAR VELOCITY, AND BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE PEAK VALUE 

QNDIDATES (Xs, Vxs, ojbs, ZMPrecpeak). 
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DETERMINE INITIAL BODY VERTICAL POSmONAELOQTY {Zs, Vzs). 
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USING DYNAMIC MODEL, GENERATE GAIT FOR ON STEP ON THE BASIS OF NORMAL 
TURNING GAIT PARAMETER INaUDING ZMPrecpeak, TAKING e bs,(Xs, Vxs, ojbs), 
(Zs,Vzs) AS INITIAL STATES OF BODY. 
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CONVERT TERMINAL BODY HORIZONTAL POSITION, VELOCITY, POSTURE ANGLE, AND ANGULAR 
VELOQTY OF GENERATED GAIT INTO VALUES OBSERVED FROM SUPPORTING LEG COORDINATE SYSTEM 
OF NEXT STEP, AND DENOTE THE VALUES BY (Xe, Vxe, 9 be, o^be). 



BOUNDARY CONDITION ERRORS (errx, errv, erre, errcu) 
= (Xs, Vxs, e bs, (obs)-(Xe, Vxe, e be, cube) 
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S214 yes , ^ 

Tj;nn TTT^ TT C LEAVE REPETITION LOOP. ) 

ARE ALL errx, errv, err e b, AND errwb / ' 

WITHIN PERMISSIBLE RANGES? 



DETERMINE A PLURAUTY OF CANDIDATES (Xs+ a Xs, Vxs, cu bs, ZMPrecpeak), 

(Xs, Vxs+ aVxs, ojbs, ZMPrecpeak), (Xs, Vxs, wbs+A tobs, ZMPrecpeak), 

(Xs, Vxs, oj bs, ZMPrecpeak+ a ZMPrecpeak) IN THE VICINITY OF (Xs, Vxs, w bs, ZMPrecpeak), 

AND BASED ON THEM, DETERMINE BOUNDARY CONDITION ERROR CORRESPONDING 

TO EACH OF THEM AS DESCRIBED ABOVE. 
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DETERMINE NEW CANDIDATES (Xs, Vxs, o^bs, ZMPrecpeak) ON THE BASIS OF BOUNDARY 
CONDITION ERRORS CORRESPONDING TO (Xs, Vxs, oj bs, ZMPrecpeak) AND EACH OF 
CANDIDATES IN THE VICINITY THEREOF. 
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DETERMINE INITIAL BODY HORIZONTAL POSITION, VELOQTY, POSTURE ANGLE, AND ANGULAR VELOCITY 
(XO, VxD, e bO, wbO), INITIAL BODY VERTICAL POSITION AND VELOCITY (ZO, VzO), AND INITIAL BODY 
POSTURE ANGLE AND ANGULAR VELOCITY AT ORIGINAL INITIAL TIME 0. 
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DETERMINE NORMAL TURNING INITIAL DIVERGENCE COMPONENT q[0] 
ACCORDING TO THE FOLLOWING EXPRESSION. 
q[0] = XO + VxO/a,0 
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DETIRMINE q", WHICH IS THE VALUE OF NORMAL TURNING INITIAL DIVERGENCE COMPONENT q[0] 
OBSERVED FROM SUPPORTING LEG COORDINATE SYSTEM OF CURRENT TIME GAIT, AND (ZO", VzO"), 
WHICH ARE VALUES OF INITIAL BODY VERTICAL POSITION AND VELOCITY OBSERVED FROM SUPPORTING 
LEG COORDINATE SYSTEM OF CURRENT TIME GAIT. 
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FIG. 17 
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PROVISIONALLY DETERMINE ZMP CORREOIOH PARAMETER CANDIDATE a AND BODY IHaiNATlOM 
RESTORING MOMENT ZMP-CONVERTED VALUE PEAK VALUE CANDIDATES (ZMPrecpeoka, ZMPrecpeakb). 
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CALCULATE PROVISIONAL CURRENT TIME GAIT UNTIL TERMINATING TIME ON THE BASIS OF PARAMETER 
OBTAINED BY CORREQING ZMP PARAMETER, WHICH HAS BEEN PROVISIONALLY DETERMINED BY 
PROVISIONAL DETERMINATION PROCESSING OF CURRENT TIME GAIT PARAMETER, BY ZMP CORREGION 
PARAMETER CANDIDATE a, BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE 
PEAK VALUE CANDIDATES (ZMPrecpeaka, ZMPrecpeakb), AND OTHER CURRENT TIME GAIT PARAMETERS. 



DETERMINE TERMINAL DIVERGENCE COMPONENT qO[k] ACCORDING TO THE FOLLOWING 
EXPRESSION FROM BODY POSITIONAELOaTY (Xe, Ve) 
AT TERMINATING END OF CURRENT TIME GAIT: 
qO[k] = Xe + Vxe/a;0 
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DETERMINE TERMINAL DIVERGENCE COMPONENT ERROR errq 
ACCORDING TO THE FOLLOWING EXPRESSION: 
errq = qO[k] - q" 
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TERMINAL BODY POSTURE ANGLE ERROR eberr 
= NORMAL GAIT INITIAL BODY POSTURE ANGLE 

- CURRENT TIME GAIT TERMINAL BODY POSTURE ANGLE 
TERMINAL BODY POSTURE ANGULAR VELOCITY ERROR cuberr 
= NORMAL GAIT INITIAL BODY POSTURE ANGUWR VELOCITY 

- CURRENT TIME GAIT TERMINAL BODY POSTURE ANGULAR VELOCITY 
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ARE ALL errq, 6 berr, AND oj berr 
WITHIN PERMISSIBLE RANGES? 



<^ LEAVE REPEHTION LOOPQ 
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DETERMINE A PLURALITY OF CANDIDATES (a+ A a, ZMPrecpeaka, ZMPrecpeakb), 

(a, ZMPrecpeaka-i- A ZMPrecpeaka, ZMPrecpeakb), AND 

(a, ZMPrecpeaka, ZMPrecpeakb+ A ZMPrecpeakb) IN THE VICINITY OF 

(a, ZMPrecpeaka, ZMPrecpeakb), AND BASED ON THEM, DETERMINE ERROR CORRESPONDING TO 

EACH OF THEM AS DESCRIBED ABOVE. 



DETERMINE NEW PARAMETER CANDIDATES (a, ZMPrecpeaka, ZMPrecpeakb) ON THE BASIS OF 
'a, ZMPrecpeaka, ZMPrecpeakb) AND ERROR CORRESPONDING TO EACH OF CANDIDATES IN THE 
VICINITY THEREOF. 
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BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE OF NORMAL GAIT (ZMPrec) 
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